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ABSTRACT 



Autonomous Underwater Vehicles (AUV's) are being 
considered for a diversity of U.S. Navy missions. They 
protend the advantages of cost effective fleet multiplica- 
tion, minimal detectability, and reduced risk to personnel 
and high-value fleet assets. In response to the Department 
of the Navy and DARPA interests, AUV research and 
development by a number of public and private sector 
organizations has intensified in recent years. The Naval 
Postgraduate School has now built the first of a series of 
AUV models which will be used as "test-beds" for evolving 
automated control technologies. This thesis documents the 
results of initial efforts to install an on-site facility to 
support the design and development of a model-based digital 
autopilot for control of the NPS test vehicle. Using an IBM 
PC/AT and analog-digital interfacing, the development 
methodology has been implemented and verified by a 
simplified model reference control program for AUV dive 
plane commands. 
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INTRODUCTION 



A . BACKGROUND 

The concept of a hierarchical automated intelligent 
controller, or autopilot, as a state-of-the-art design 
methodology is clearly evident from the proceedings of [Ref. 
1] . As a part of an inter-disciplinary research program, 
the Naval Postgraduate School is investigating many facets 
of automated control technologies for underwater vehicles. 
One of the objectives of this program has been to develop 
operating ”test-bed" vehicles and the facilities for 
developing and evaluating real-time control systems. 

In support of this objective, recent studies have led to 
the development of a model-referenced control methodology. 
Using the equations of motion for a vehicle of known 
hydrodynamic characteristics, computer simulation was used 
to develop the command generation logic, the design of a 
model following autopilot and evaluate the performance of 
the selected AUV computer model [Ref. 2]. 

Based on this vehicle's characteristics, subsequent 
research led to the design and construction of the first of 
a series of operational AUV models which will be used to 
evaluate evolving automated control technologies [Ref. 3]. 
This model was used to develop a technique for the 
identification of discrete transfer function relationships. 
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In-water tank tests were conducted for maneuvers in the 
vertical plane and from these, data was acquired and 
compared with the computer model simulation. A system 
transfer function relating dive plane commands to vehicle 
response was then determined. 

B. RESEARCH OBJECTIVES 

The focus of this research has been to implement a 
microcomputer based capability to support AUV data 
acquisition, vehicle response and transfer function 
identification, and the development of real time digital 
control programming. 

Specific objectives included: 

1. The acquisition and integration of available 
hardware and software. 

2. The documentation of specific implementations and 
configurations used for the various phases of 
program development to date. 

3. The development of a high-level language program 
for real-time control of the AUV test vehicle 
dive plane maneuvering based on the methodology 
and results of the research reported [Refs. 2,3]. 

This program would affirm the on-site development 
procedure and identify insufficiencies or 
incompatibilities which would need to be 
resolved to support future research. 

This thesis documents the accomplishment of these 
objectives. The integration of hardware and software are 
discussed and evaluate in the overall perspective of the 
program development process. A program was developed and 
verified. This control program was written in Turbo Pascal 
and processes three analog sensor signals and issues a 
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digital diveplane command. The development procedure has 
been verified, however certain shortcomings in multi-channel 
signal processing and software compatability are discussed. 
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II. EQUIPMENT DESCRIPTION. APPLICATION AND 
PROCEDURAL DOCUMENTATION 



A. THE DESIGN AND CONTROL PROGRAM DEVELOPMENT PROCESS: 

AN OVERVIEW 

The development of real-time autonomous control programs 
is a dynamic and evolutionary process. It is the link 
between computer simulations of the systems and the 
implementation of controllers to achieve desired performance 
of these entities in the real-world. Autonomous controllers 
are exceedingly complex. In the early stages of controller 
development, software implementations operating in 
micro-computers which interface the device afford an 
opportunity for verification and optimization of design 
methodology and parameters. Once designs have been 
evaluated, the design logic is then implemented in an 
onboard controller. In this final implementation, much of 
the control program coding will have been replaced by 
functionally equivalent micro-electronic devices which 
permit economies in size and power as well as flexibility of 
application. The remaining control logic is micro-coded 
and programmed on micro electronic storage devices. 

A principal objective of this research was the 
integration of available software and hardware to support 
the various activities in control program development for 
the AUV. These activities fall into three broad categories: 
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Data Acquisition, Data Analysis, and Design and 
Implementation of real-time control programs. 

- Data Accnaisition involves the assimilation of vehicle 
parameters and responses to known inputs under 
controlled conditions. 

- Data Analysis involves the analysis of vehicle 
performance data for the purpose of extrapolating 
quantitative relationships between input commands and 
vehicle responses. These relationships are then 
reflected as gain factors in transfer functions which 
describe the AUV behavior or state. 

- Design and Implementation of real-time control programs 
entails the representation of controller logic in 
programming code. This software operates in a 
micro-computer suitably interfaced with the AUV to 
permit the sampling of vehicle sensor data and to issue 
appropriate commands. 

This chapter summarizes the specifications of the 
hardware and the software utilized to support these phases 
in the research reported herein. The phases and application 
of these resources are depicted in Figure 2.1. Concluding 
sections of this chapter document specific configurations 
and commentary which supplement manufacturer's technical 
reference materials with regard to this research 
application. Comments regarding the performance and 
suitability of these resources are reported in Chapter IV. 



B. MICROCOMPUTER DESCRIPTION 

An IBM PC/AT (compatible) microcomputer was acquired for 
this and future research. This computer operates at 6 or 10 
MHz and with 0 or 1 wait states. An Intel 80286 
microprocessor and an 80287 math co-processor were 
installed. The Random Access Memory (RAM) is expandable 
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AUV AUTOPILOT : 
ONBOARD IMPLEMENTATION 



L— — OPERATING SOFTWARE 
— ^ "FIRMWARE" 

MICROELECTRONICS 



Figure 2.1 Phases of Program Development 
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from its current size of 640 Kbytes. Installed floppy disk 
drives include a 1.2M byte (high density) and 360K byte 
floppy disk drives are installed. The floppy disk 
controller has the capability of controlling an additional 
3.5 inch disk drive as well. A 40M byte hard disk is also 
installed. 

C. SIGNAL PROCESSING: ANALOG-DIGITAL INTERFACE 

Interfacing the micro-computer and the AUV is critical 
to the program development process. At this interface 
analog AUV sensor signals are digitized for the computer 
control program through an A/D conversion process. 

Similarly, digitized command signals are converted to analog 
equivalent signals by D/A conversion processing prior to 
transmission to the AUV analog servo-control components. 

The A/D signal processing was utilized exclusively during 
AUV test trials for data acquisition. Both modes of signal 
processing were utilized in development of the control 
program. A detailed description of the configurations 
during these phases are reported later in this chapter. 

This section concludes with a description of the devices 
used to achieve the analog-digital signal processing 
interface and a summary of the technical specifications 
detailed in the manufacturer's literature [Ref. 4]. 

Interfacing the AUV and the computer was accomplished 
using two modern device boards. The model DT 2801-A is a 
programmable, single board, analog and digital I/O signal 
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processor. This board is one of a series designed for the 
IBM Personal Computers and was installed into one of the 
backplane slots on the computer's mother board. Once 
installed, a multi-pin connector, accessible at the back of 
the computer, facilitates connecting the DT 2801-A to an 
external screw terminal panel, the DT 707, by a ribbon cable 
and connector. The DT 707 was used to connect AUV sensor 
inputs, the command output, and an external trigger signal. 
Specific configurations are discussed later in this chapter. 

The following summarizes detailed technical 
specifications contained in the manufacturer's product 
literature [Ref. 4]. 

1 . DT 2801-A Digital and Analog Signal Processor 

This device supports A/D conversion processing on 8 
differential analog or 16 single ended, unipolar or bipolar, 
input channels with 12-bit resolution. Similarly, there 
are 2 D/A conversion channels for processing output signals. 
Software selectable gains accommodate a range of input 
signals. With 12-bit resolution and programmable gains it 
is possible to achieve a conversion accuracy on the order of 
+/- 0.03% of Full Scale Reading (FSR) . An onboard clock can 
be used to initiate data conversion events for periods of 
2.5 microseconds to 0.819 seconds in 1.25 microsecond 
increments. For more precise initiation of data conversion 
events or to synchronize with control program timing, an 
external trigger input is also available. Throughput, the 
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time to execute one complete read or write cycle, of 27.5 
KHz can be achieved under Direct Memory Access (DMA) 
procedures . 

The onboard processor is programmable by any 
language that can access I/O registers of the IBM PC. Also, 
pre-programmed, user callable, subroutines are available for 
use with this device under the product name PCLAB. [Ref. 5] 
Similarly, a complete Data Acquisition software package, 
DT/NOTEBOOK is also available. [Ref. 6] These products 
were used in this research and are described in later 
sections of this chapter and in chapter 3. 

2 . DT 707 Screw Terminal Panel 

This unit along with the ribbon cable and connector 
facilitate connection of I/O channels for analog to digital 
signal process and digital to digital signal processing. 
There are also terminal connections for external trigger 
signal sources. 

D. SOFTWARE INTERFACING, ANALYSIS AND PROGRAMMING 

1 . Data Accmisition 

This phase of program development was greatly 
facilitated by the use of a software program, DT/NOTEBOOK. 
[Ref. 6] The details of its employment and the system 
configuration are reported in the next section. 

2 . Data Analysis and AUV System Identification 
Assuring the capability to analyze vehicle test data 

and identify discrete transfer function relationships was a 
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principal objective of this research. This analysis was 
accomplished and reported in [Ref. 3] using a CAD Program 
called MATRIXx [Ref. 7] This program affords an extensive 
set of design and analysis functions for classical and 
state-space control. It also provides a state-of-the-art 
matrix analysis and graphical display capability. 

3 . Control Programming Utilities and Language 

PC LAB consists of a library of low level routines 
which are callable as procedures, functions or subroutines 
in the following high level programming languages: BASIC, 

FORTRAN, Pascal, Turbo Pascal and C. These routines include 
single and multiple channel, or block, A/D and D/A 
conversion, with buffered storage and DMA control options. 
[Ref. 5] It should be noted that multiplexing of selected 
inputs using multiple channel, or block read, procedures is 
on the order of microseconds when using the DT 2801-A signal 
processing board. [Ref. 4] This sample interval was 
considered to adequately simulate "instantaneous” sampling 
of discrete vehicle parameters. Another signal processor, 
the DT 2818, is advertised to have "simultaneous sample and 
hold" and multiplexes the input channels on the order of 
nanoseconds. This processor may have application in future 
program development. 

The control program reported in Chapter III was 
written in Turbo Pascal and compiled to run under either PC 
DOS or MS DOS operation systems. [Ref. 8] The facility of 
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the Turbo Pascal program development environment, the 
intrinsic ability to manipulate text and data, the screen 
graphics capabilities and recursive procedure calls were 
strong considerations in the selection of this programming 
language. Discussion regarding use of specific PC LAB 
routines and Turbo Pascal programming are presented in 
Chapter III. 

E. DOCUMENTATION AND CONFIGURATION FOR AUV DATA ACQUISITION 

This section documents the configuration of hardware and 
provides commentary on the application of the DT/NOTEBOOK 
program as it was used in acquiring data during actual tank 
testing. Figure 2.2 depicts the system configuration for 
this phase of the research. 

The DT/NOTEBOOK is a menu-driven data acquisition 
program with options for data analysis. (These options were 
not used, however, in favor of the more powerful CAD program 
MATRIXx previously discussed.) The DT/NOTEBOOK program 
affords a high level user interface with the DT 2801-A 
signal processor and was used exclusively for AUV data 
acquisition during tank testing. The comments in this 
section are intended to supplement the excellent tutorial 
and user documentation provided with the DT/NOTEBOOK program 
[Ref. 6] with comments specific to this research. 

During the AUV trials three channels of analog data were 
sampled, digitized and stored for subsequent analysis. The 
three channels of sensor data consisted of depth, from a 
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Figure 2.2 System Configuration for Data Acquisition 



transducer output; speed from a dynamic head transducer, and 
pitchrate from a pitchrate gyro. The configuration of the 
DT 2801-A/DT 707 terminal panel interface with the AUV is 
shown in Figure 2.3. 

DT/NOTEBOOK uses a hierarchical menu concept much like 
Lotus 123. Menu selections are made by either moving the 
highlighted input box with the cursor keys until it 
"captures” the desired option and then pressing the <Enter> 
or by merely pressing the key corresponding to the first 
letter of the command name. As successive options are made, 
the user moves deeper into the menu hierarchy. At each 
level, a new menu of commands or data input options is 
presented. Pressing the <EXC> key moves the user back out 
of the menu one level at a time. 

Figure 2.4 illustrates the Main Menu. The program is 
contained on 12 disks. The first of these is a "Key Disk" 
which must be inserted in Drive A during installation and 
whenever the program is first executed. Installation 
instructions are clear and specific and are selected from 
the Main Menu using the INSTALL command. During the 
installation, two directories are created on the hard disk; 
Drivers and Notebook. Once the installation has been 
completed, the user merely locates himself in the Notebook 
directory, inserts the Master Key in Drive A, and enters 
"nb" from the keyboard. The program then displays the Main 
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Figure 2.3 Terminal Board Configuration for 
Data Acquisition 
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SETUP GO ANALYZE CURVE-FIT FFT INSTALL PROGRAM QUIT 
Perform data acquisition / control 



DT/ NOTEBOOK 

Figure 2.4 DT/NOTEBOOK Main Menu 

Menu of selections. The Master Key disk may then be removed 
and is not needed again during the current program session. 

The QUIT command exits the program and returns to the 
Disk Operating System (DOS) . The PROGRAM command allows the 
user to depart the Notebook program and execute programming 
in DOS and then return to Notebook without having to "re- 
boot" the program with the Master Key disk. This feature 
operates must like a programmable interrupt in that the 
"status" of Notebook is saved for the period that the user 
is in DOS and is restored upon returning to the Notebook 
program. 

The CURVE FIT and FFT commands are intrinsic program 
capabilities for curve fitting and fast fourier transform 
operations on data files. The ANALYSIS command permits the 
user to call an external analysis program of the user's 
choosing. (Lotus 123 was used as an example in the 
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documentation.) This permits analysis and graphical 
representation from within the Notebook program. These 
features were not used in this research. Acquired data were 
analyzed and graphed using MATRIXx as a stand-alone program. 

The remainder of this sub-section describes the data 
acquisition process used extensively in this research and 
which was executed using the SETUP and GO commands from the 
Main Menu. Figure 2.5 depicts a flowchart of the system 
configuration ''setup” and data acquisition initiation, or 
"Go,” process. It should be noted that once a suitable 
configuration has been achieved it can be saved as a setup 
file and recalled for future use. There were several such 
files saves in this research, however the file named 
AUVSETUP was used almost exclusively and its configuration 
is reflected in the figures referenced in the sub-section. 

From the Main Menu, selecting the SETUP command results 
in the presentation of five configuration commands shown in 
Figure 2.6. 

The CHANNELS command allows the user to configure the 
software to the physical hardware connections of the DT 
2801-A/DT 707 interface. The user is first asked to choose 
between NORMAL or HIGH SPEED data acquisition. The NORMAL 
command was used throughout this research. The HIGH SPEED 
option was not needed for the sampling required in this 
research. This mode places restrictions on data display. 
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Figure 2.5 



DT/NOTEBOOK Data Acquisition Process 
Flowchart 



17 



CHANNELS FILES DISPLAY VERIFY SAVE/RECALL 
Initialize data acquisition / control 



Figure 2.6 DT/NOTEBOOK SETUP Command Menu 
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Figure 2.7 DT/NOTEBOOK NORMAL Mode Menu 
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memory requirements and data buffering and file creation 
which must be considered if this mode is used. 

Selecting the NORMAL command results in the presentation 
of the NORMAL Mode Menu, Figure 2.7. A list of "setup 
conditions" is presented down the left side with a column of 
cells for user entries to the right. Entries are made by 
using the cursor to "capture" the desired cell with the 
highlighted input cell. Configuration specifications are 
input using appropriate keys which are "echoed" in the 
Current Value cell in the upper left hand corner of the menu 
display. Pressing ENTER or moving the input cell with the 
cursor key enters the configuration in the program. The 
program offers some specific options for various setup 
conditions which are displayed by pressing FI. It should be 
noted that the DT 2801-A can sample up to 16 input channels 
(0 ... 15) and these are specified by Interface Channel 
Number. The user must recognize the distinction between the 
"data channels" specified in the first four lines of the 
menu and the interface channel. The data channels are user 
creations based upon the data requirements. The interface 
channels are physical input connections to the signal 
processor. 

In this research, data channel 1 was always configured 
as TIME and used to record elapsed time for an event from 
the DT 2801-A processor clock. The remaining 4 data 
channels were specified to receive sensor input signals. 
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Figures 2.8-2.12 illustrate these configuration 
specifications . 

The next SETUP command is FILES. The option data files 
are configured to meet user requirements. Figure 2.13 
illustrates a data file setup which was used for most of 
this research. There are two points which need to be 
emphasized. The first is that after each run, the user must 
return to this menu and change the "Data File Name." If 
this is not done, NOTEBOOK will overwrite the new data into 
the same file. Secondly, the data field specification must 
be specified to meet the input data file requirements of 
MATRIXx if the acquired data are to be analyzed in this 
program. A machine executable data conversion program 
(convdata.exe) was written to convert NOTEBOOK data into 
MATRIXx acceptable data. After gaining more familiarity 
with both these programs, it was discovered that the data 
conversion program was not necessary. If properly specified 
in the NOTEBOOK and MATRIXx, data can be used directly. 
Future researchers should consider the experimental data 
requirements and then consult the documentation of these 
programs to effect the proper configuration. 

One last documentation remark has to do with the file 
naming convention used in this research. Confoirming to the 
MS-DOW rules for naming files, data files for AUV trials 
were named as the following example illustrates: 
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Figure 2.8 DT/NOTEBOOK Channel 1 Configuration 
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Figure 2.9 DT/NOTEBOOK Channel 2 Configuration 
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Stage Duration, sec. (0.0.. 1 .OE ♦ 0 8 J 20.000 

Start/Stop yethod Noraal 

Trigger Channel 1 

Trigger Pattern to AND (0..255J 0 

Trigger Pattern to XOR (0..2S51 0 

Tlae Delay, sec. (0.0..l.0E*08 J 0.000 



Figure 2-10 DT/NOTEBOOK Channel 3 Configuration 



Current Value; 4 



NORyAL DATA ACQUISITION / CONTROL SETUP 
Nuaber of Channels ^ 

Current Channel(s) (n or n..al 4 

Channel Type Analog Input 

Channel Naae OlVE CyO 

Interface Device 0- DT2801A 

Interface Channel Nuaber {0..151 ® 



Input Range ql.25 V 

Scale Factor 

Offset Constant 0.000 

Buffer Size 2048 

Nuaber of Iterations ^ 

Nuaber of Stages (1..4) ^ 

Saapllng Rate, Hz 20.000 

Stage Duration, sec. 10.0..1.0E + O81 20.000 

Start/Stop Method Noraal 

Trigger Channel ^ 

Trigger Pattern to AND (0..2551 0 

Trigger Pattern to XOR (0..255) 0 

Tlae Delay, sec. (0.0..l.0E«^08 J 0.000 



Figure 2.11 DT/NOTEBOOK Channel 4 Configuration 
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Cufftrfil V^lue: b 



NOHMAL DATA ACQUISITION / CONTROL SETUP 
Nuaber of Channels S 

Current Cbannel(s) [n or n..al b 

Channel Type Analo< input 

Channel Naae P!TCH ANGLE 

Interface Device 0: DT2801A 

Interface Channel Nuaber [0..151 * 4 



Input Ranite qiO V 

Scale Factor 1.000 

Offset Constant 0 000 

Buffer Size 204b 

Nuaber of Iterations 1 

Nuaber of Stages [1..4] 1 

Saapllng Rate. Hz 20.000 

Stage Duration, sec. [0.0 .. 1 .OE « 0 8 ] 20.000 

Start/Stop Method Normal 

Trigger Channel I 

Trigger Pattern to AND [0..25S1 0 

Trigger Pattern to XOR [0..2SS] 0 

Tlae Delay, sec. [0.0.. 1 .OE 0 8 ] 0.000 



2 • 12 DT/NOTEBOOK Channel 5 Conf iguiration 



Current Value: 1 



FILES SETUP 



Number of Data Files [0..12] 
Current Data File [1..1] 

Data File Name 
Storage Mode 

Number of Header Lines [0..4] 

Header Line 1 

Header Line 2 

Header Line 3 

Header Line 4 

Nua. of Channels in File (0..1001 



1 

1 

AV01091 S.DAT 
ASCII Real 
4 

AUV SYSTEMS IDENTIFICATION DATA 
9 JAN 1988 : RUN 18 
The time is STIME. 

The date is SDATE. 

5 



File Channel Number 



2 3 4 



S 



Channel 


Number 


1 


2 


3 


4 


5 


Channel 


Name 


TIME 


PTCHRATE 


DEPTH 


DIVE CMD 


PTCHANCL 


Channel 


Units 


Seconds 


volts 


volts 


volts 


VOLTS 


Field Width (ASCII Files) 


12 


12 


12 


12 


12 


Decimal 


Places (ASCII Real Files) 


4 


4 


4 


4 


4 



Figure 2.13 DT/NOTEBOOK Data Files Setup 
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AV010915.DAT 

AV : denotes AUV data acquired from NOTEBOOK 

01 : denotes the month of the trial, i.e., January 

09 : denotes the day of the month of the trial 
15 : denotes the particular trial for the day 
DAT: was the extension used for all data files. 

Files which were converted by the data conversion program 

for analysis with MATRIXx were named by the same convention 

except ••UV” was used for the first two characters. Thus the 

file UV010915.DAT would indicate that this is the data file 

converted from AV010915.DAT for use with MATRIXx. 

The next SETUP menu option is DISPLAY. This command 
specifies the setup for the real-time display of data as it 
is being acquired. This feature is most beneficial in 
evaluating the quality of the data collected. It should be 
noted that in achieving a visual display the program invokes 
a liberal "graphical license" and so the displays afford a 
relative measure and not an exact replication of the data 
acquired. The stored data file is unaltered by the display 
configuration specification. 

The DISPLAY command presents the user with two menus: 
WINDOW SETUP and TRACE SETUP. In these menus the user can 
specify the number, size and type of the display windows and 
the data trace characteristics. There is considerable 
flexibility and the program documentation should be 
consulted to exploit this feature. Figures 2.14 and 2.15 
illustrate configurations used in this research to display 
three windows and their respective traces. 
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Current Vulue: 



Nuaber of Windows [0..l5| 

Window Nuaber 
Left Llalt, xO (0.0. .1.0) 

Lower Llalt, yO (0.0., 1.0) 

Hum Llalt, xl (0.0.. 1.0) 

Upper Llalt, yl (0.0.. 1.0) 

Y Axis Title 
X AXIS Title 

Leni^tb of Tlae (X) Axil In sec. 
X Tic Start Value 
X Tic End Value 
Nuaber of X Tics {0..11] 

Y Tic Start Val 



WINOpW SETUP 
3 



O.l 50 
0.1 00 
0.950 
0.300 
PTCllRT 
TIWK/SEC 
30.000 
0.000 
30.000 
7 



0.1 50 
0.400 
0.950 
0.600 
V DEPTH 
TIME/SEC 
30.000 
0.000 
30.000 
7 



0.150 
0.7 50 
0.950 
0.950 

V DVCMD ^ 
TIME/SEC 
30.000 
0.000 
30.000 
7 



Figure 2.14 DT/NOTEBOOK Window Setup Configuration 



Current Value: 4 



TRACE SETUP 



Nuaber of Traces (0..S0) 

Trace Nuaber 
Window Nuaber (1..15) 


4 

1 

1 


z 

2 


3 

3 




Line Color 


Black 


Red 


White 


Yellow 


Line Type 


Solid 


Solid 


Solid 


Solid 


Data Point Syabol 


None 


None 


None 


None 


Y Channel Nuaber 


2 


3 


4 


5 


Y Ulniaua Displayed Value 


-0.500 


0.000 


-0.500 


10.000 


Y Uaxlaua Displayed Value 


0.500 


10.000 


0.500 


10.000 


Trace Type 


T vs. Y 


T vs. Y 


T vs. Y 


T vs. Y 


ForMetersOnly: * 

Nuaber of Declaal Places 


3 


3 


3 


3 


For Type XY Only: 

X Channel Nuaber 


1 




3 


4 


X Ulniaua Displayed Value 


0.000 


0.000 


0.000 


0.000 


X Uaxlaua Displayed Value 


10.000 


10.000 


10.000 


10.000 



Figure 2.15 DT/NOTEBOOK Trace Setup Configuration 
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The next SETUP is VERIFY. Executing this command 
displays a screen which reflects the configuration which a 
user has specified. This provides a good check of the 
system setup. 

The last SETUP command is SAVE/RECALL. As the title 
suggests this command allows the user to save a particular 
configuration setup as a specific file or to recall such a 
file for reuse. 

Once a system configuration has been specified and the 
AUV is connected to the DT 2801-A/DT 707 interface, actual 
data acquisition is initiated by selecting the GO command 
from the Main Menu. In its default configuration, the 
program will commence data acquisition as soon as GO is 
selected. However, a useful feature is the "Keystroke 
Before Run" which is selectable in the INSTALL, OPTIONS 
commands. This delays the beginning of data acquisition 
after GO is selected until "any other key" is depressed. 

This feature was used throughout this research as it 
permitted more precise control over the data acquisition 
events . 

F. DOCUMENTATION AND CONFIGURATION FOR AUV CONTROL 

Figure 2.16 depicts the system configuration for control 
of the AUV under high-level language control programming. 
Figure 2.17 shows a schematic of the DT 707 terminal 
connections. Owing to the non-availability of the test tank 
and suitable radio transmitter interface module to transmit 
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I MICROCO>fPUTER RIBBON CONNECTION 




Figure 2.17 Terminal Board Configuration for 
Real-time Control 
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the generated dive plane command to the AUV, real-time 
control was not accomplished in this research. Figure 2.18 
shows the system configuration used to simulate real-time 
control configuration in the development and verification of 
the control program. Details of the program development and 
verification are reported in Chapter III of this thesis. 
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Figure 2.18 System Configuration for Simulation of Real-time AUV Control 



III. PROGRAMMING VERIFICATION 



This chapter reports on the final objective of this 
thesis: verification of I/O processing of analog and 

digital signals under higher-level program control. The 
following sections discuss the design, implementation, 
verification and documentation of this program. A complete 
and documented listing of the main program is contained the 
Appendix. 

A. PROGRAM PERSPECTIVE AND DESIGN 

The introduction of [Ref. 2] presents a concise 
description and illustration relating this concept to this 
and other current research at the Naval Postgraduate School. 

The theory of classical (closed loop) controllers as well 
as modern state-space design of Digital Autopilots are 
further discussed in [Refs. 10,11]. In its final 
implementation, a digital autopilot will control all six 
degrees of freedom of the AUV in the execution of a variety 
of missions and in a diversity of operating environments. 

The architecture of the autopilot will reflect extensive 
functional modularity. Under the supervisory control of an 
"AUV Operating System," missions will be executed as a 
sequence of tasks compiled and ordered by the onboard 
planning logic and knowledge database. Similarly, 
completion of these tasks will reflect the compilation and 
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execution of functional capabilities in sequence or in 
parallel under the control of a lower-level operating 
system. These functional capabilities may well be 
implemented as multi-processors each reflecting a 
hierarchical organization specific to their required 
functional responsibility. 

Timing will be a critical to the successful assimilation 
of functional modules and the accomplishment of tasks and 
missions. The top level "AUV Operating System” will provide 
a master synchronizing timing signal based optimal 
considerations of the cycle-time requirements of the 
subordinate processors. Cycle-time is the time required to 
receive, process and transmit information. Cycle-time will 
be most affected by the processing interval. Modern digital 
controller design must therefore concern itself with 
optimizing response and processing time requirements. 

A Model-Referenced Autopilot design was evaluated and 
found to be most suited to control of the rapid maneuvering 
and changing environmental and "plant” parameters which will 
be encountered in an AUV [Ref. 2] In contrast to the 
classical accomplishment of vehicle maneuvers through the 
independent action of rudder and diveplane for course and 
depth control, a Model Referenced design will be a 
multivariable control structure. It will require the 
parallel processing of vehicle sensory data to determine a 
vehicle state, comparison with a model reference state and 
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the determination of an appropriate command. As 
verification of the on-site program development capability, 
this research sought to investigate the cycle time 
requirements of a high-level language control program which 
emulated the modular organization of a model referenced 
controller and exercised the signal processing functions of 
the DT 2801-A hardware and software. 

B . PROGRAM IMPLEMENTATION 

This program represents a functional module at the 
lowest level of the digital autopilot hierarchy: the 

analog-digital interface between the AUV servo-controllers 
and the onboard digital processing capability. As discussed 
in Chapter II, the verification process was simulated using 
signal generators (Figure 2.18). Three analog sensory 
signals, simulated by inputs from signal generators are 
sampled. These signals, represent AUV transducer outputs 
for depth, speed and pitchrate. The amplitude of these 
signals are representative of actual AUV signals measured 
during tank testing. Respective ranges of amplitudes of 
these signals are +/- 10, +/- 5, and +/- 1.25 volts. The 
sampled analog signals are then processed by the program: 
the speed and pitchrate signals are processed for display 
only; the depth signal is processed by the control modules 
which generate an outgoing command (voltage) to the 
diveplane actuator channel. An external trigger simulates 
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the master timing signal as it might be implemented in an 
actual processor onboard an AUV. 

The program implements a closed loop control process 
within a user interface shell. As depicted in the program 
pseudo-flow chart (Figure 3.1), the user enters a desired 
AUV target depth and then turns control of the AUV over to 
the control loop. It was intended that the user have the 
facility to interrupt the control sequence by pressing key 
<F1> to enter a new target depth, <F2> to halt the 
controller and reset the program, or <ESC> to exit the 
program. It was discovered in the final assembly of the 
program modules, however, that the PCLAB signal processor 
routines masked the keyboard interrupt device thus denying 
access to programmable interrupts for program control. 
Although this problem did limit the interactive features of 
the program, it did not interfere with the active control or 
validation of the development system. This problem is 
discussed in Chapter IV. 

This program utilizes routines which are provided with 
the PCLAB real-time software. In many of the compiled 
language implementations which includes Turbo Pascal, these 
routines are programmed as functions which return integer 
error codes as well as passing analog or digital data 
values. Programming these routines is accomplished by 
declaring an integer variable and then calling the desired 
routine. For example, STATUS is the declared integer 
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MAIN MENU 



Q ... QUIT return to DOS 
R . . . RUN the Control Program 



STATUS and COM>IAND 



GET TARGET DEPTH 

3 : 

CLOSED LOOP CONTROL 



. . . While no keypressed 




IF 


KEY 


FI 


IF 


KEY 


F2 


IF 


KEY 


ESC 



GET NEW TARGET DEPTH 
RESET PROGRAM FOR NEXT RUN 
EXIT PROGRAM AND RETURN TO ^ENU 



Figure 3.1 Closed Loop Control Program Flow Chart 
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variable used in the program code. Calling a single value 
Analog to Digital conversion is accomplished with the 
following statement: 

status= adcvalue (<channel ' , <gain>, <user declared 

data variable >) 

< > denote required declarations 

Literally interpreted, this statement says that "Status gets 
the integer error code of the function adcvalue." Error 
codes are automatically processed by an error processor and 
if an error is encountered in the data conversion, an error 
message is printed to the display screen. The data values 
are passed to the program as value parameters and may be 
treated as any other data parameter in program coding and 
manipulation. PCLAB reportedly supports single or block 
data conversion routines. However several attempts to use 
the block routines to convert data from selected sensor 
channels were not successful. This problem is discussed in 
Chapter IV. 

The following sub-sections supplement the program 
commentary found in program listing (Appendix) , and describe 
the salient modules which implement the Closed Loop Control 
routine. The titles of the subsections correspond to the 
title of the program modules as listed in the Appendix. 
Appendix D [Ref. 5] contains the algorithms for analog and 
digital conversions. These have been used in the following 
procedures where such data manipulation is required. 
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1. Initialize Zero Digital Signal Out 



This routine must executed at the beginning of the 
program so as to send a zero voltage digital signal out. 

The DT 2801-A defaults to sending out a minimum full scale 
reading out as soon as it is powered up. It is therefore 
important to '•zero” the output signal before attaching the 
test vehicle. This routine "zeroes” the signals of both 
analog to digital output channels. 

2 . Convertspeed. Convertdepth and Convertoitchrate 

These are three functions which convert digital-to- 

analog data values to AUV parameters. The algorithms for 
these conversions are based on tank tests conducted on the 
AUV and are reported in [Ref. 3] 

3 . GetTaraetPePth 

This procedure solicits the AUV operating depth from 
the user (an integer input) and converts it to an analog 
voltage based upon the depth to voltage relationship derived 
during testing. This equivalent analog voltage is passed to 
the control program for control processing. 

4 . GetDiaitalSensorvData 

This procedure samples three channels of sensory 
input and converts them to AUV analog equivalent values 
using the previously mentioned functions. These values are 
then passed to the control program as representing the state 
of the AUV. Several designs were envisioned using single 
and block data transfers so as to achieve a suitable 
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throughput and synchronization of this event. ADConTrigger 
is a single value conversion routine which executes on the 
high to low transition of an external trigger. As soon as 
this conversion is completed, two ADCValue commands convert 
data for the remaining two sensory channels. Timing studies 
for a single value conversion affirmed a throughput on the 
average of 0.6 msec. The throughput for the one triggered 
and two single value conversions averaged 2.5 msec. 

5 . Errorvolts 

This procedure computes a difference or error 
voltage between the analog voltages for target and actual 
depths. A "voltage filter" has been implemented to permit a 
tolerable difference range above and below the target depth. 
This precludes trying to achieve an absolute zero difference 
which is an not a practicable design in manipulating the 
digital to analog conversions. It also allows the AUV a 
defined range in which no changes in plant operating 
parameters are required to maintain a desired depth. The 
computed error voltage is then passed to the control program 
for processing by the GenerateDiveCommand module. 

6 . GenerateDiveCommand 

This procedure simply converts the computed error or 
difference voltage to an analog equivalent and sends this 
signal out on the specified analog to digital channel. 
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C. PROGRAM VERIFICATION 

The verification configuration and objectives have been 
previously stated. The evaluation of the cycle time 
requirement is based on the minimum required AUV sampling 
time in order to maintain real-time control. A critical 
real-time control interval of 50 mSec or a sampling rate of 
20 Hz was established as a standard based upon evaluation of 
data collected and reported in [Ref. 3]. 

Notwithstanding the problems encountered with 
programmable interrupt control and block data conversions 
using the PCLAB routines, high-level program control of the 
analog and digital I/O signal processing was achieved. 

Cycle times were measured at various sampling rates as 
simulated by the frequency of the external trigger signal. 
Figures 3. 2-3. 4 show the results of these timing studies. A 
cycle time on the order of 5 msec was recorded. This cycle 
time is well within the required limit and affords an ample 
margin for more extensive sensor sampling, control 
processing and multiple command generation. 

D. PROGRAM DOCUMENTATION 

The documentation of the program listing and the 
previous sections in this chapter have described the logic 
and function of the program. This section documents the 
filenames and other information which may assist follow-on 
research. 
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Figure 3.2 Program Cycle Time Trace at 8 Hz Trigger Rate 
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Figure 3.3 Program Cycle Time Trace at 12 Hz Trigger Rate 
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Figure 3,4 Program Cycle Time Trace at 20 llz Trigger Hate 



The control program is named AUVPILOT with extensions of 
.PAS and .COM for the Turbo Pascal and executable machine 
codes, respectively. The included files declared at the 
beginning of the program listing (Appendix) all have a file 
extension .AUV. These programs provide utility support for 
screen displays and program timing. Some of these programs 
are adaptations of routines discussed in [Ref. 9], while 
others were created to meet specific needs of the main 
program. 

The Turbo Pascal v 3.0 programming environment and 
language features are thoroughly explained in [Ref. 8]. No 
additional explanation is considered necessary. One major 
consideration in the utility of this programming language is 
that in the recently released 4.0 version, the code size 
limitation of 64K bytes has been eliminated thus making it 
suitable for very large program applications. The 
compatibility problems with PCLAB routines still remain to 
be resolved, however. PCLAB does not as yet support this 
latest version. 
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IV. SUMMARY. CONCLUSIONS. AND RECOMMENDATIONS 



A. SUMMARY 

The thesis has described the hardware and software 
details of an IBM-PC based controller as a shell for further 
development. The software has been used for digital data 
acquisition and cycle time studies have been performed for 
throughput of control signals operating from an external 
trigger source. 

B. CONCLUSIONS 

The work of this thesis demonstrated the ability of an 
IBM-PC based microcomputer, coupled with an advanced D/A and 
A/D conversion board to provide both data acquisition and 
control functions that will be required in any 
implementation of an intelligent controller for Automated 
Underwater Vehicles. 

Cycle time for sensing three signal channel inputs, 
computation of tracking error, and sending of updated 
control signals is 5 msec. With a sample time of 0.05 
seconds, 45 msecs are available for storing data, updating 
vehicle parameter estimates, and interfacing with higher 
level supervisory control programs. The trigger for sample 
initiations, at present, is timed by an external clock. 

The structure implemented herein, is now capable of 
being expanded to incorporate the control signal 
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formulations necessary to achieve full implementation of an 
automated digital autopilot. 

C. RECOMMENDATIONS 

The problems with programmable interrupt control and 
multiple, or block, data conversions discussed in Chapter 
III present several issues which need to be resolved. 

First, if Turbo Pascal is to be used in future research, 
these problems will have to be resolved through direct 
correspondence and consultation with the development firm. 
Furthermore, the near-term availability of PCLAB routines 
for Turbo Pascal v 4.0 should be assured so as to support 
development of large control programs. At this juncture in 
the research, it is perhaps best to evaluate other compiled 
high-level languages with respect to the stated benefits of 
Turbo Pascal and the programming requirements of more 
complex Digital Autopilot implementations. Program 
interfacing with other, more "intelligent” digital control 
modules should also be considered so as to assure future 
integration of program modules under development by the 
various departments at the Naval Postgraduate School. 
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APPENDIX 



LISTING OF CONTROL PROGRAM CODE 

prograa AuvAutoPllot ( Input, output ); 

( TITLE : AutonoBous Underwater Vehicle Auto Pilot Prograa. 

AUTHOR : CDR Stephen W. Delaplane, USN 

APPLICATION : Partial fulfillaent of Thesis Research for the degree 
Masters of Science In Mechanical Engineering. 

DATE : 18 March 1988 

Project Description : This prograa iapleaents digital control of the NFS 
autonoBOUS underwater vehicle (AUV) in the vertical or dive plane.lt saaples 
vehicle sensor input froa three channels : depth, speed, pltchrate. The 
depth signal is then passed to a DepthError aodule which coapares the actual 
sensor depth with a aodel reference depth siaulated by a depthgain. A depth 
error voltage is then generated and passed to a Generat eOivePlaneCoBaand 
aodule which processes the error signal and sends out an appropriate coaaand 
to the dlveplane actuators. The gains In the algorlthas reflect the discrete 
transfer function gains for dlveplane coaaand response derived froa vehicle 
Identification analysis. } 

{ GLOBAL DECLARATIONS 



const 

{ Screen declarations 

xl = 5; 

yl = 2; 

x2 = 75; 

y2 = 24; 



type 

strlO = string [10]; 
str60 = string [60]; 

var 

hr,hr2,Bin,aln2, 

sec,s ec2,hun,hun2 : byte; 

seconds : real; 

option, controlaode, 
reply, reply2 : char; 



} 

{ Upper left corner : left edge ) 

( Upper left corner : upper edge ) 

{ Lower right corner : right edge > 

{ Lower right corner : bottoa edge } 



{ INCLUDED FILES Declarations ) 



($I pcldefs.tp } (PC LAB Trubo Pascal routines. } 

(91 pclerrs.pas } (PC LAB error code aessages file. } 

(Sllnldac.auv ) 

( This procedure Initializes the DT 2801-A TO ZERO VOLTS AND MUST BE 
EXECUTED BEFORE THE AUV IS HOOKED TO THE COMPUTER. It is called as 
procedure InitializeZeroDigit alSignalOu t. ) 

(Slgettlae.au V } (No arguaents; returns hr, Bin, sec, hun : byte } 

(Slshotadf f.auv } 

{ Input the output of TlaeDiff.auv and this procedure displays the tiae 
difference between the two aost current (jetTlae.auv results. 

ShowTlaeDif f erene ( x:integer) . ) 
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($tt laedif f.auv) 

( Input: hr,hr2ymin,Bln2,sec,sec2,hun,hun2 froa two calls 
of GetTine.auv and this returns the difference In 

seconds as a REAL variable. ) 

($Idra wbox2.auv } 

( Input xl,yl,x2,y2 : Integer to specify the corner llaits of the box. 

This procedure clears screen and draws a rectangular box of specified 
dimension using ASCII double line characters. } 

($Iclrbox2.auv) 

( Input xl,yl,x2,y2 : integer to specify the corner limits of the box. 

This procedure uses a FAST means of clearing a box of specified dimension. 

The box dimension should be delcared as constants. } 

(Slboxpr int.auv ) 

( Input the prlntrow, leftboxedge, rlghtboxedge ; Integer and printstring : 
str60. This procedure centerprints the string in the box at the prlntrow 
specified without overwriting the box border. ) 

(SIshow f as t.auv) 

( Input message : str60, column,row : integer. To specify the x,y position 

on the screen for a FAST message print. } 

(Slkeyhit.auv) 

( This is a boolean function which returns true or false if key is pressed; 
it also returns keycode replies VAR reply, reply2 : char . > 

(Sltabxy.auv) 

( Input tabcolftabrow : Integer; like gotoxy ) 

(1Iboxpause.au v) 

{ Input xpause,ypause ; integer to specify where "Press any key to continue" 

message is to be printed. } 

(11getkey.au V } 

( Input as a string of chars, the set of acceptable replies; le 'YyNn'. This 
procedure waits until one of the acceptable replies has been entered. } 

(llutils.auv } 

( Included are some housekeepping and debugging routines. } 

(llconvadv.auv } 

( Includes functions to convert depth, speed and pitchrate to vehicle values. } 
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{ PROGRAMS PROCEDURES 

( «*«<<>>«««««<<<«< USER INTERFACE MODULES 
procedure MalnMenu ( var reply : cbar ); 



xxxxxxsxxxssxsxxxxsssxxxxxxx 

xxxxxxxxxxxxxxxxxxzxxxxxxxxx 



{ This procedure presents the AUV screen and solicits an option to Run 

the AUV fro« the S tatusAndCoaaand procedure or to Quit. ) 



begin 

repeat 

clrscr: 

drawbox2(xl,y I,x2,y2); 

boxprint(yl^3,xl,x2/N AVAL POSTGRADUATE SCHOO L’); 
boxprint(yl^5,xl,x2/D EPARTMENT OF’); 

boxprint(yl'^6,xl,x2,’M ECHANICAL ENGINEERIN G’); 

boxprint(yl ^8, xl,x2, ’AUTONOMOUS UNDERWATER VEHICLE’); 

boxprint(yl + 10, xl,x2, ’DIGITAL AUTOPILOT CONTROL PROGRAM’); 

boxpr in t(yl ^12, xl,x2, ’*********************** ***************’); 
boxprint(y 1-^15, xl,x2/Do You want to RUN this program 
boxprint(y l^l6,xl,x2,*or Do You want to QUIT and return to DOS ?’); 
boxprint(yl^20,xl,x2,’»» ENTER Q OR R <«<’); 
getkey (’QqRr',reply,reply 2); 
until ( reply in [’Q’,'q’,'R’,’r'] ) and (reply2 = chr(O)); 
end; 



procedure St at u sAndCoaaand ( var node : char ); 

( This procedure begins the control prograa screen. ) 



var 

mode2 : char; 

procedure S t at u sAndConnandScreen; 

{ This is the status and control screen and solicits a user input of FI to 

RUN the prograoi or Q to Quit and exit to the main menu. ) 

begin { St atusAndCommandScreen } 

clrbox2 (xl,y l,x2,y 2); 

boxprint(yl + l,xl,x2,’AUV STATUS / COMMAND AND CONTROL SCREEN’); 
boxprlnt(yl^2,xl,x2/= = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = ==’); 
boxprlnt(yl-»-7,xl,x2, ’CHOOSE YOUR DESIRED CONTROL MODE :’); 
boxprlnt(yl^'S,xl,x2, ’ENTER KEY << FI » TO START AUV CONTROL’); 
boxprlnt(yl + ll,xl,x2, ’ENTER « Q » TO QUIT AND RETURN TO MAIN MENU’); 
boxprint(yl^'16,xl,x2, 'PRESS EITHER FI OR Q’); 

end; ( St at usAndCommandScreen ) 
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( 



t CLOSED LOOP CONTROL ROUTINES 



ssssxxxsssvcssssxxxx 



procedure ClosedLoopCont rol; 

( This module comprises the closed loop control scheme. } 



cons t 

maxdepth - 33; 

mlndepth = 0; 

updat elncremen t = 10; 



type 

activecontrolmode = ( run, reset, exit ); 
allowabledepthr ange = mlndepth. .maxdepth ; 



au va t tl tude 



climb, maintain, diving ); 



dlgl tallnt egerarr ay = array [1..3] ot Integer; 



auvdepth, auvdepthvolts,auvspeed, 

au vspeedvol t s, au vpl tchr at e, au vpltchrat evolt s, 

deptherrorvolts, targe tdepthvolts 

adv 

j,s t atus 

moder eply,moder eply 2 

activemode 

targetdepth, 

updatecounter 

depthr ange 

attitude 



real; 

: digit allntegerarray; 
: Integer; 
char; 

: activecontrolmode; 

: Integer; 

: allowabledepthrange; 
: auvattltude; 



(unction convertdepth ( analogvalue : real ) : real; 

{ This (unction converts a depth analog volts value to an AUV status 

parameter. This (unction Is derived (rom experimental observation. } 



begin 



(unction convertdepth 



convertdepth ;= ( analogvalue - 1.6270 ) / 0.2570 ; 



) 



end; 



function convertdepth 



} 



(unction convertspeed ( analogvalue : real ) : real; 



{ This (unction converts a speed analog volts value to an AUV status 

parameter. This (unction Is derived (rom experimental observation ) 

{ Speed of the AUV was determined by hand-timing the vehicle’s passage in the 
test tank, over a distance of 8(t ( 2 window panels ) while holding the speed 
voltage constant. Various trials were performed at different Input voltages 
to establish a voltage to speed relationship. In theory this Is a quadratic 
relationship. The data alluded to a quadratic relatlonslp, but because the 
voltage saturated the range quickly, It was difficult extract a precise 
(unction. Accordingly this (unction asserts average speed values (or various 
ranges of voltages based on the timing trials. This conversion will 
undoubtedly become better defined as more vehicle data is taken and analyzed.) 

begin { (unction convertspeed ) 
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1£ ( analogvalue <= 2.32 ) then 

convertspeed := 0.0 
else if ( analosvalue > 2.3200 ) and ( 
convertspeed 1.2678 

else if ( analo^value > 2.5200 ) and ( 
convertspeed 1.3913 

else If ( analosvalue > 2.5440 ) and ( 
convertspeed 1.8233 

else if ( analogvalue > 2.6200 ) then 
convertspeed := 1.8233 
end; ( 



analogvalue 


< = 


2.5200 


) 


then 


analogvalue 


< = 


2.5440 


) 


then 


analogvalue 


< = 


2.6200 


) 


then 



function convertspeed 



function conver tpitchra te ( analogvalue : real ) : real; 



{ This function converts a pltchrate analog volts value to an AUV status 
paraaeter. This function Is derived froa expe rlnent al observation. } 



const 

convertcons tant = 0.125; ( conversion constant 



) 



) 



begin ( function conver tpl tchr at e > 

convertpltchrat e := analogvalue / convertcons tant; 

end; ( function convertpl tchra te } 

procedure ClosedLoopControlScreen; 



{ This procedure displays the Closed Loop Control Screen. It Is displayed 
throughtout the AUV pllottlng run. It Is updated with status and control 
paraaeters by control routines as they execute In the prograa sequence. } 

begin ( ActlveControlScreen ) 

clrbox2 (xl,y I,x2,y2); 

boxprlnt(yl^-l,xl,x2,'A UV STATUS / CONTROL SCREE N’); 
boxprlnt(yl ^2, xl,x2,’ = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = ='); 
boxprint(yl^‘4,xl,x2, 'STATUS OF A U V OPERATING PARAMETERS 



w rlteln 


(tabxy 


(xl>5,yl>6),’AUV 


DEPTH 


[ 


In 1 


: *); 


w rlt eln 


(tabxy 


(xl>5,yl>7),’AUV 


SPEED 


c 


ft/sec ] 


: ’); 


wrlteln 


(tabxy 


(xl>5,yl>8),’AUV 


PITCHRATE 


[ 


Deg / sec ] 


: ’); 



boxprlnt(yl + 10,xl,x2/A U V CONTROL STATUS*); 

write (tabxy (xl^5,y 1 ^'12)/CURRENT TARGET DEPTH : *); 

write (tabxy (xl 5,y 1 + 1 3),'CURRENT AUV OPERATING MANEUVER : *); 
write (tabxy (xl ^-S^yl >14), 'CURRENT AUV OPERATING MODE : ’); 

boxprlnt(yl>17,xl,x2,*THIS WILL BE THE DISPLAY DURING AUV CONTROL’); 
boxprlnt(yl>18,xl,x2, 'STATUS WILL BE UPDATED EVERY SECOND. ’); 
boxprlnt(yl>19,xl,x2,’NEXT ; ENTER AUV OPERATING DEPTH ’); 
boxpause(xl > 15,y 1 >21); 

end; ( ActlveControlScreen } 



50 



procedure Get Tar je tDepth (var tgtdepth : Integer ; 

var tgtdepthvolt s : real ); 

( This procedure solicits the target AUV operating depth and converts It to 
an AUV equivalent tgtdepth analog voltage and passes both of these 
parameters. } 



begin ( Ge tTarge tDepth ) 

clrbox2 (xl,y I,x2,y2); 

boxprlnt(yl^‘10,xl,x2/ENTER THE AUV TARGET OPERATING DEPTH’); 
boxprlnt(yl'^ll,xl,x2,'>> NOTE : THE DEPTH SHOULD BE IN WHOLE INCHES <<’); 
repeat 
begin 

boxprint (y 1 1 3,xl,x2,'ENTER THE TARGET OPERATING DEPTH ’); 
gotoxy (xl^-33,yl>l5); 
read ( tgtdepth ); 

end; 

until ( tgtdepth In [0..45]); 

( This next statement converts the Integer user Input target depth to an 
analog control voltage base on tank calibration test data acquired. ) 

tgtdepthvolts := 1.627 ^ 0.257 * tgtdepth ; 

end; { GetTarge tDepth ) 

procedure RunModeScr een; 

{ This procedure displays the Closed Loop Control Screen In the RUN MODE. ) 

begin ( RunModeScr een ) 

clrbox2 (xl,y I,x2,y2); 

boxprlnt(yl^l,xl,x2/A UV STATUS/CONTROL SCREE N’); 
boxpr In t(y 1^2,xl,x2,' = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = =’) 
boxprint(yl ^4, xl,x2, 'STATUS OF A U V OPERATING PARAMETERS 

write (tabxy (xl + 5,y 1 ^-6),'AUV DEPTH C In ] : '); 

write (tabxy (xl + 5,yl>7),’AUV SPEED [ Ft / sec ] : ’); 

write (tabxy (xl^5,y 1-»'8),'AUV PITCHRATE [ Deg / sec ]: ’); 
boxprlnt(yl + 10,xl,x2/A U V CONTROL STATUS’); 

write (tabxy (xl ^-5,y 1 ^-12), 'CURRENT TARGET DEPTH ; ’); 

write (tabxy (xl ^5, yl^'13), 'CURRENT MODE : ’); 

write (tabxy (xl ^5,y 1 ^-1 4),'CURRENT MANEUVER : ’); 

boxprlnt(yl + 18,xl,x2, 

'PRESS KEY FI .. TO ENTER NEW TARGET DEPTH. ’); 

boxprlnt(y 1 ^19,xl,x2, 

'PRESS KEY F2 .. TO STOP ACTIVE CONTROL AND RESET.’); 
boxprlnt(y 1^20,xl,x2, 

'PRESS < ESC > .. TO EXIT ACTIVE CONTROL. '); 

end; { RunModeScr een ) 
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procedure Upda t eRunModeScreen (updatedepth,updatespeed,updatepitcbrat e : real; 

upda t e t arse tdept h : integer; 
updateaode: act! veCONTROLnode ; 
upda t eat tltude : au vat t itude); 

{ This module updates the Closed Loop Control Run Mode Screen with updated 
display parameters. Updates occur in intervals specified by updat eincr ement 
Interval declared In Clos edLoopCont rol procedure. } 

begin { Updat eRunModeScreen ) 

{ UPDATES STATUS OF A U V OPERATING PARAMETERS ) 

writeln (tabxy (xl ^37,y 1 ^6),updatedepth:6:2); 
wrlteln (tabxy (xl + 37,y 1 ^7),updat espeed:6:2); 
writeln (tabxy (xl ^-37,y 1 ♦■8),updatepitchrate;6;2); 

{ UPDATES THE A U V CONTROL STATUS ) 

write (tabxy (xl 30,y 1 1 2),updat e t arge tdepth:2); 
case updatemode of 

run : writeln (tabxy (xl + 30,y 1 1 3)/RUN '); 
reset: writeln (tabxy (xl ^ 30,y 1 > 1 3),'RESET’); 
exit : writeln (tabxy (xl ^ 30,y 1 + 1 3),’EX1T ’); 
end; 

case upda tea t tltude of 

maintain : writeln (tabxy (xl + 30, yl 1 4), 'MAINTAINING DEPTH ’); 



climb : writeln (tabxy (xl ^ 30,y 1 ^ 1 4), 'CLIMBING TO TARGET DEPTH’); 

diving : writeln (tabxy (xl ^ 30,y 1 ^ 1 4), ’DIVING TO TARGET DEPTH ’); 

end; 

end; { Updat eRunModeScreen 



procedure Ge tDigltalSensor y Da t a ( var depthanalogvolt s,speedanalogvolt s, 

pit chrat eanalogvolts :real) 



{ This procedure uses PCLAB routines 
channels from the AUV and digitizes 
by the specified gains. 

DT 2S01-A / DT 707 Board set up: 



to sample selected input telemetry 
these Inputs and multiplies them 



channel 1 - AUV depth input 

channel 2 - AUV speed input 

channel 3 - AUV pitchrate Input 



} 



const 



( These are artificial gains used to simulate AUV telemetry during program 
development. One signal from a signal generator (^/- 1.25, 9 Hz, 
characteristic of the pitchrate signal) Is Input to all 3 Input channels. 

Gains are applied to simulate the actual values. These and their appli- 
cation In the procedure body should be removed after program development 
Is completed. ) 



depthgain = 1.0; 

speedgaln - 2.0; 

pltchrat egain = 1.0; 



Jonvert the digitized Analog Data Values for speed, depth, pltchrate to 
analog voltage values. The algorithm for this conversion is found in 
Appendix D of the PCLAB documentation. 



) 



dept hanalogvolt s ( depthadv * (depthpfs -dept hmf s)/noc ) 

speedanaiogvolt s ( speedadv * (spdpf s -spdm fs)/noc ) 



^ depthmfs; 
^ spdmfs; 



pi tchrat eanalogvoit s := ( pltchrateadv * 

(pit chrat epf s - pit chra t emf s)/noc ) 

^ pltchratenf s; 



end; { procedure GetDigl t alSensoryDa t a ) 

procedure Errorvolts ( tdepthvolts, adepthvolts : real; 

var derrorvolts: real; 

var attitude : auvattitude ); 

{ This module represents the "AUV Model Reference Stale Space." Actual 

depth telemetry and the target depth are compared and a voltage difference 
is computed. This difference is then "dropped" through a voltage filter 
to determine if the difference if within an acceptable tolerance, or if a 
corrective divepiane command is necessary. A "model gain" is applied to 
the voltage difference and an errorvoltage is calculated and passed to the 
main program for dive command generation. Although these parameters are 
single valued, in a multi-state control program these parameters could be 
implemented as arrays and the model gain array could be the result of a 
real-time program running synchronously with the main control program. ) 

{ COMPUTATIONAL SIGN CONVENTION: The voltage difference Is computed as the 
difference between TARGET DEPTH, or desired AUV depth, and the ACTUAL 
DEPTH. A PLUS voltage DIFFERENCE generates down dive plane command; 

A MINUS voltage DIFFERENCE generates an UP dive plane command. ) 



cons t 

depthcont rolt olerence = 0.1; 

modelgain = 1.0; 



var 



volt sdif f erence ; real; 



This simulates a model referenced } 

( gain parameter ) 



begin { Errorvolts 

volt sdif f erence tdepthvolts - adepthvolts; 
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C These are AUV to DT 2801-A / DT 707 hook up board channel configurations, 
conversion and computational arguments. ) 

( AUV output to DT-707 Input channel assignment) 

( Peak depth signal value ) 

( Ulnlfflum depth signal value } 

( AUV output to DT-707 Input channel assignment) 

( Peak speed signal value } 

C Minimum speed signal value ) 

( AUV output to DT-707 Input channel assignment) 

C Peak pltchrate signal value ) 

( Minimum pltchrate signal value ) 

( Number of Codes; conversion resolution. 

The DT 2801-A performs a 12 bit conversion. 
NOC = (2 ^ conversion bits), le 4096 ) 



depthchannel 


= 


1; 


depthpf s 


= 


^“10.0; 


depthmf s 




-10.0; 


speedchannel 


= 


2; 


spdpf s 


= 


+ 10.0; 


spdmf s 


— 


-10.0; 


pit chr at echannel 


= 3; 


pi tchr a t epf s 


= 


+ 10.0; 


pltchr a temf s 


= 


-10.0; 


noc 


= 


4096; 



{ SetUpAdc and ADConTrlgger PCL function arguments 

: p 6-8 PCL documentation ) 



boardnuffl =1; 

numa2dchan = 3; 

tlmlngsource = 2; 

adcgaln = 1; 

startchannel = 1; 

endchannel = 3; 



{ -- Sets a external t rigger, Int ernal clock ) 
{ Sets the A/D gain; 1,2, 4,8 are options ) 



var 

speedadv, 
depthadv, 
pltchrat eadv, 

slgnaladv, { Signal analog data value ) 

counter, status, 

chanum,l,J : Integer; 

begin { procedure GetDlgltalSenso ryDat a ) 



{ Set up the DT 2801-A board to take data, 
status SelectBoard (boardnum); 



) 



{ Set up the DT 2801-A board to take data from 
sampling Is Initiated by the ADConTrlgger single 
depth channel and then single ADC value samples 
follow. The Trigger Is connected to the DT 707 
a signal generating source. 



3 Input channels; Data 
channel sample of the 
of the speed and pltchrate 
board at terminal 49 from 



) 



status 
s t atus 
status 



ADConTrlgger ( depthchannel, adcgaln, depthadv ); 
ADCValue ( speedchannel, adcgaln, speedadv ); 
ADCValue ( pltchrat echannel, adcgaln, pltchrateadv ); 
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( ^ + ^ ^ 4- + ^ Control voltage filter + + + + + ) 

( These conditions check if depth is within tolerence. If so a zero error 

is assigned so as to result in a zero diveplane conmand. ) 

if ( vol t sdlf f erence > 0) and 

( abs(voltsdiff erence) <= depthcon t rol t oler ence ) then 

begin 

derrorvolts := 0.0; 
attitude := nalntaln; 

end 

else If ( volt sdlf f erence < 0) and 

( abs(volt sdlf f erence) <= depthcont rol t ole rence ) then 

begin 

derrorvolts :■= 0.0; 
attitude := aaintain; 

end 

( This condition checks if actual depth is less than target ^ tolerence. 

In this case a DIVE connand is necessary to correct depth. ) 

else if ( volt sdif f erence > 0) and 

( abs(voltsdlf ference) > depthcontrol tolerence ) then 

begin 

derrorvolts := volt sdif ference * modelgaln; 
attitude diving; 

end 

( This last condition checks to see if the actual depth is more than target ^ 
tolerence. In this case climb command is necessary to correct depth. } 

else if ( volt sdlf ference < 0) and 

( abs(volt sdif ference) > dept hcontrolt oler ence ) then 



begin 

derrorvolts := volt sdif fer ence * modelgaln; 
attitude := climb; 
end; 



end; ( Errorvolts 



procedure Genera t eDlveplaneCommand ( dlvecommandvolt s : real ); 

( This procedure CONVERTS the analog ERRORVOLTS signal to a digital equi- 
valent voltage and sends this as a COMMAND to the AUV Interface device 
for transmission as a DIVE PLANE COMMAND. It uses a single DACValue 
routine call. ) 

const 

( DT 2801-A DIGITAL TO ANALOG Conversion declarations ) 

d2achannel = 0; 
pfs = 10; 

•fs = - 10; 
noc = 4096; 

var 

digltaldatavalue, status : integer; 
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function Conver t Analog2Digit al ( analojjvalue : real ): Integer; 

( This function converts analog signal volts to an equivalent 
digital value. See App D of PCLAB book. } 

var 

temp : real; 

begin 

temp ( analogvalue - mfs ) * ( (noc - 1) / (pfs - mfs ) ); 

conver tanalog2dlglt al := round ( temp ); 

end; 

begin ( Gene ra t eDlvePlaneCommand } 

digit aldatavalue := conver t analog2dlglt al ( dlv ecommandv olt s ); 

{ status := Initialize; ) 
status := selectboard (1); 

status := dacvalue ( d2achannel, digit aldatavalue ); 

( status ;= terminate; } 

end; ( Generat eDlvePlaneCommand ) 



procedure Ini t lallzeParame t e rs ; 

( This procedure Initializes all declared control and display parameters to 

zero. ) 

begin ( procedure Inlt lallzeParameter s } 

auvdepthvolt s 0.0; 
auvspeedvolt s := 0.0; 
auvpltchrate volts ;= 0.0; 
auvdepth := 0.0; 
auvspeed := 0.0; 
auvpltchrate ;= 0.0; 

end; ( procedure InitializeParamet er s } 
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begin 



( 



ClosedLoopControl 



) 



activemode run; 

Initialize parameters; 

repeat ( Repeat until *actlvemode = exit ) 



repeat ( Repeat until activemode = reset } 

ClosedLoopControlScreen; 

Ge t Ta rge t Dept h ( targetdepth, t arge tdepthvoi t s ); 

RunModeScr een; 

while ( not keyhlt ( modereply, modereply2)) do 
(NOTE: THIS IS THE PROGRAMMABLE INTERRUPT WHICH IS MASKED BY THE PCLAB 

ROUTINES. THE USER MUST USE A CONTROL-BREAK < CNTRL^> TO STOP PROGRAM 
EXECUTION AND EXIT THE PROGRAM. ) 



begin 

updat ecount er 0; 

while < upda tecoun t er < upda t eincrement ) do 
begin 

Ge tDigi t alSensor yDa t a (auvdepthvolts^auvspeedvolts, 

auvpitchratevolt s ); 

Errorvolts ( t arge tdepthvoi t s, au vdepthvol t s , 
depther r or volt s, attitude); 



Genera teDiveplaneCommand ( depther rorvolts ); 
updat ecountcr := updat ecount er 1; 



end; C while updatecoun ter < updat eincrement } 

auvspeed ;= convertspeed ( auvspeedvolt s ); 
auvdepth convertdepth ( au vdepthvolt s ); 
auvpitchrate convertpl tchra te ( auvpitchratevolt s ); 

Upda teRunModeScreen ( auvdepth, auvspeed, auvpitchrate, 

targetdepth, activemode, attitude ); 

end; t while not KeyHit ) 



If (ord(modereply) = 27) 
activemode := run 
else if (ord(modereply) 
activemode := reset 
else if (ord(modereply) 
activemode := exit; 



and (ord(modereply2) = 59) then 

{ KeyHlt=Fl ) 

27) and (ord(modereply 2) = 60) then 

{ KeyHlt=Fl } 

27) and (ord(moder eply 2) = 0) then 

{ KeyHit= ESC) 



until ( activemode = reset ) or (activemode = exit ); 



until ( activemode = exit ); 
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end; { ClosedLoopCont rol } 

begin { S tatusAndCoanand 

repeat 

S ta tusAndComnandScreen; 

Get Key (”,mode,mode 2); 

If ( ord (mode) = 27 ) and ( ord (mode2) = 59 ) then 
begin 

clrbox2 (xl,y I,x2,y2); 

ClosedLoopCont rol; 

end; 

until ( mode In [’Q’/q’l ); 

end; { S tatusAndCommand 



procedure Ini t lalizeZe roDigi t alSignaiOu t; 

( This procedure MUST be executed as the first procedure called in the main 
program to Insure a zero signal out on the 2 output channels. Otherwise the 
DT 2S01-A board defaults to a minimum full scale output. } 



cons t 

digitalchanO = 0; 

digitaichanl = 1; 

digit alcommandboard = 1; 



var 

st atuS) 

digit aldatavalue : integer; 
begin 

digit aldatavalue ;= 2048; { This will be converted to an equivalent 

zero analog signal out on a 12 bit 
resolution converter like DT 2801-A. 



status 
status 
s t a t us 
status 
s tatus 
end; 



initialize; 

selectboard ( digit alcommandboard ); 
dacvalue ( digitalchanO, digi t aldatavalue ); 
dacvalue ( digitaichanl, digit aldatavalue ); 
terminate; 



procedure DeactivateADBoardAndExit Program; 



{ This procedure deactivates the DT 2801-A board and presents 
an exit screen. 



) 



) 



var 

status ; integer; 

begin { Deact ivat eADBoardAndExitProgr am ) 

status terminate; 
clrbox2 (xl,yl,x2,y2); 
boxprint (y 1^10,xl,x2, 

'THIS CONCLUDES YOUR AUV AUTOPILOTTING SESSION , BYEO; 
end; { Deact ivat eADBoardAndExitProgram ) 
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begin { 

Ini t laiizeZe roDlgltalSlgnalOut; 
clr scr; 
r epea t 

MainMenu ( option ); 

If ( option in ['R',’r']) then 
begin 

repeat 

begin 

S t atusAndCommand ( controlaode 
end; 

until ( controimode in C’q’,’Q’]); 
end; 

until ( option in C'Q\’q’]); 

DeactlvateADBoardAnd Exit Program; 

END. { 



MAIN PROGRAM 



); 



MAIN PROGRAM 
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